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Abstract. Methods for resolving kinematic redundancies of manipulators by the effect 
on joint torque are examined. When the generalized inverse is formulated in terms of 
accelerations and incorporated into the dynamics, the effect of redundancy resolution 
on joint torque can be directly reflected. One method chooses the joint acceleration 
null-space vector to minimize joint torque in a least squares sense; when the least 
squares is weighted by allowable torque range, the joint torques tend to be kept within 
their limits. Contrasting methods employing only the pseudoinverse with and without 
weighting by the inertia matrix are presented. The results show an unexpected stability 
problem during long trajectories for the null-space methods and for the inertia-weighted 
pseudoinverse method, but rarely for the unweighted pseudoinverse method. Evidently 
a whiplash action develops over time that thrusts the endpoint off the intended path, 
and extremely high torques are required to overcome these natural movement dynamics. 
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1 Introduction 

Increasing interest in manipulator redundancy is a direct consequence of perceived 
limitations of current 6 degree of freedom robots. On the one hand, singularity regions 
of 6 degree of freedom rotary manipulators occupy such a significant portion of the 
workspace as to render them functionally only 5 degree of freedom manipulators (Paul 
and Stevenson, 1983) . On the other hand, workspace obstacles may sufficiently constrain 
movement as to effectively reduce the degrees of freedom. 

Most analysis of redundant arms has proceeded independent of consideration of any 
particular mechanism. HoUerbach (1984b, 1985) proposed a 7 degree of freedom kine- 
matic design with a spherical shoulder joint to eliminate singularities and to improve 
workspace. Yoshikawa (1985a) proposed a 4 degree of freedom wrist to overcome the 
usual problem of wrist singularity. In practice very few redundant manipulators have 
been constructed. At research laboratories, 7 degree of freedom arms of anthropomor- 
phic geometry include a tendon-driven, torque-controlled robot (Takase, Inoue, and 
Sato, 1974) and the UJIBOT, driven by DC servo motors (Nakamura, 1985). An 8 
degree of freedom redundant sheep-shearing robot has been discussed in (Trevelyan, 
Kovesi, and Ong, 1983) . Commercially, 7 degree of freedom robots have been produced 
by the Robotics Research Corp., also of anthropomorphic geometry, and by Cybotech, 
whose P-15 robot has a yaw axis in the forearm (Litvin et al., 1985). In addition, a 
number of 6 degree of freedom robots have been mounted on linear tracks, but it is hard 
to count this 7th degree of freedom into fine motion control of the endpoint. 

Thus, while the incidence of redundant arms in research labs and industry is grad- 
ually increasing, present research in redundant arms has progressed primarily at a 
theoretical and simulation level, in advance and expectation of available mechanical 
hardware. 

1.1 Kinematic Resolution of Redundancy 

The vast majority of research into the control of redundant arms has involved the 
instantaneous resolution of the redundancy at the velocity level through use of the 
pseudoinverse J ' of the Jacobian matrix J. If x is the 6-dimensional velocity vector of 
the hand and 6 is the n > 6 dimensional vector of joint angles, then 

X = je (1) 

$ = jtx+(I-jtj)^ (2) 

jt = J''(JJ^)-^ (3) 

where ^ is an arbitrary joint velocity vector and (I- JTJ)^ is its projection into the null 
space of J, corresponding to a self-motion of the linkage that does not move the end 
effector. The pseudoinverse is also known as the Moore-Penrose generalized inverse. The 
attractiveness of this approach is twofold. First, the pseudoinverse is one of the types 
of generalized inverse that has a least squares property (Ben-Israel and Greville, 1980) , 
in the present case minimizing B. Presumably any joint is prevented from moving too 
fast, leading to a more controllable motion (Whitney, 1969). It is also presumed that 



squared velocities are approximately related to kinetic energy, which would then also 
be approximately minimized (Whitney, 1969, 1972) . 

Second, the redundancy available beyond that required for the tip motion is suc- 
cinctly characterized by the null space of the Jacobian, which may be freely utilized to 
assist in the realization of some chosen objective. Liegeois (1977) developed a general 
formulation for instantaneously minimizing a position-dependent scalar performance 
criterion p = g{0). The null space vector that minimizes p is ^ = kdg/dO, where k is an 
arbitrary constant, and yields the solution 

^ = jti+(I-jtj)fc|| (4) 

Liegeois demonstrated a way of avoiding joint limits, by minimizing the scalar function 

^ ^ I Qinii _ Qmax I V^l 

where Bf^'' and ^f '"" are the upper and lower joint angle limits for joint i and 5,^" = 

The null space vector has also been used in singularity avoidance. Yoshikawa (1984) 
proposed minimizing a dexterity measure w, called by him the manipulatability measure, 
given by 

w = y/det{33T) (6) 

Since at a singularity tw = 0, then the scalar function p = —w{6) instantaneously 
maximizes w and tends to keep the arm away from singularities. Klein (1985) compared 
various dexterity measures including w and decided instead on the minimum singular 
value. 

At a singularity a nonredundant manipulator can actually execute a self motion, 
since for example a 6 degree of freedom robot has an excess freedom with regard to the 
5 degree of freedom endpoint motion possible at the singularity. The null space vector 
corresponding to this self motion is useful if the endpoint variables are partitioned 
into high-priority variables x^, which must be realized, and low-priority variables ij, 
which are sacrificed to avoid the singularity but which should be realized insofar as is 
possible (Hanafusa, Yoshikawa, and Nakamura, 1981), For example, in spray painting 
the control of rotation about the spray direction is not as important as the control of the 
other positioning variables, and could be sacrificed at a singularity. From the relations 

h = ^hO (7) 

xi = Jii (8) 

e = jIx, + (i-jIj,)^ (9) 

the null space vector left over after realizing the high priority variables is found by 
substituting (9) into (8): 

0=[J,(I-jK)]t(x,-J,jIi,) (10) 



Substituting into (9) yields 

e = jIx, + [j,(i - Jlj.)]t(x, - JjjIx,) (11) 

where use has been made of the identity B[CBY = [C-B] i , with B = {I - j|j/,) a 
hermetian and idempotent matrix (Maciejewski and Klein, 1985). 

The null space vector can aid obstacle avoidance (Maciejewski and Klein, 1985). 
Suppose Xg is some point on the arm closest to an obstacle, J,, is the Jacobian such 
that Xg = 3oO, and x^ is a movement of this point away from the obstacle that would 
be desirable. In a procedure like that above, <j) is found by substituting (1) into this 
relation: 

^ = [J„(I - Jtj)]t(i^ - J„jti) (12) 

After substitution and simplification, the joint rates that avoid the obstacle are: 

^ = jti + [J^I - jtj)]t(i^ - J^jti) (13) 

One problem with the Moore-Penrose inverse is that its application is nonconserva- 
tive (Klein and Huang, 1983) . Repetitive motions planned with the pseudoinverse alone 
do not return at a given tip point to the same joint configuration. Baillieul (1985) has 
proposed an extended Jacobian method, which may be used to make a repetitive motion 
conservative. If rij is a vector from the one-dimensional null space of J, obtained by 
taking cross products of columns of J, and g[&) is a scalar function to be minimized, 
then define 

G(« = ^.n. (14) 



The extended Jacobian Jea is then defined by 
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Assuming the manipulator is nonsingular, this relation may be inverted directly to find 
9. It is possible to recast this method in terms of a generalized inverse with null space 
vector. 

An entirely different mechanism from use of a null space vector to realize desired 
performance characteristics is the weighted pseudoinverse. The generalized inverse JT^ 

•T 

that instantaneously minimizes the cost WO is (Whitney, 1969, 1972) 

jt^ = W-^J^(JW-ij^)-i (16) 

where W is a matrix of weights. Whitney (1969) proposed an alternative method 
for enforcing high and low priority of hand variables through appropriate selection of 
weights. Konstantinov, Markov, and Nenchev (1981) used weights to avoid joint limits. 
Most research involving the pseudoinverse deals with the instantaneous kinematics 
of motion, that is to say, motion that is locally optimized by incremental movement 



from the current arm state. The Jacobian has also been used in dexterity measures to 
aid global trajectory planning and the avoidance of singularities. Uchiyama, Shimizu, 
and Hakomori (1985) parameterized joint angles by polynomials and optimized manipu- 
latability w integrated across the whole trajectory by gradient adjustment of polynomial 
coefRcents. Nakamura and Hanafusa (1985) used Pontryagin's Maximum Principle to 

•T • 

minimize a cost function combining manipulatability w, and 6 0, interpreted by them 
as energy, for global determination of trajectory. 

1.2 Kinetic Resolution of Redundancy 

The previous redundancy resolution schemes are purely kinematic, despite the pre- 
sumption that since the sum of squares of joint velocities is minimized by the pseu- 
doinverse, then the kinetic energy is approximately minimized. True minimization of 
kinetic energy would only be realized if the generalized inverse were weighted with the 
inertia matrix, so that the relation to kinetic energy of an unweighted pseudoinverse is 
not clear. The kinetic energy is 

r = l^m (17) 

where H is the inertia matrix. Minimizing the kinetic energy T is just Whitney's 
criterion with the weighting matrix W = H in (16). 

To incorporate the generalized inverse into dynamics, the pseudoinverse must be 
formulated in terms of accelerations. Khatib (1980, 1983) was one of the first researchers 
to do this, in his case using the inertia-weighted pseudoinverse: 

X = J^ + J^ (18) 

i = J'^h(?-J^) (19) 
The dynamic equations in closed form are (HoUerbach, 1984) 

r = Hi + ^-C-^ + g. (20) 

where previously undefined terms are C, the matrix of Coriolis and centrifugal coeffi- 
cients, and ^, the gravity vector. Hence the joint torques are given by 

r = HjtH(x- J^) + ^-C-^ + g. (21) 

Vukobratovic and Kircanski (1985) broadened the method of Khatib to include en- 
ergetic models of hydraulic and electromagnetic motors, and applied the resultant gen- 
eralized inverse to velocities. 

While kinetic resolution of redundancy incorporates dynamics, the resulting formu- 
lation is only indirectly related to torque production at the joints. A major reason for 
attempting to reflect directly the eifect of redundancy on joint torque is to avoid ex- 
ceeding torque limits. Past work has been concerned with characterizing the endpoint 
accelerations that depend on the utilization of the redundancy and on torque limits. 



rather than on an actual application to trajectory planning. Yoshikawa (1985b,c) de- 
fined a dynamic manipulability ellipsoid, derived from a pseudo-endpoint acceleration 
X = X — 36 related to a pseudo-torque 1 = 1 — ^-C-^ — grby 



X = JH-V (22) 

The derivation proceeds at zero velocity by a kind of normalization of the torques 
according to range. The upper r"*" and lower t~ joint torque bounds are presumed equal, 
and each pseudo-joint torque is normaUzed as f,- = ?«/(7",^ — |ff.|)- Ignoring bounds on 
acceleration, then 

I = JH~V (23) 

where H = WH and W = diag{l/{T^ - \g.\)) is a diagonal weighting matrix. The 

dynamic manipulability ellipsoid consists of the set of x that are derivable from a unit 
input r < 1, obtained from the dot product 

|''(Hjt)^Hjt| < 1 (24) 

The dynamic manipulability index w is derived from this relation, and is an extension 
of (6) through the inclusion of inertia: 



w = ydet{JCH^Il)-'^jT) (25) 

This index has not yet been applied to redundancy resolution. 

Khatib (1985) presented a different normalization for torque range in a procedure 
similar to Yoshikawa's. Defining 

f,- = mm(|rr - ^,|, \t^^ - ^,|) 

the weighting matrix is W = diag{l/ti). Khatib applied this procedure to adjust a two- 
link manipulator's link lengths and masses to optimize the isotropic nature of endpoint 
acceleration throughout the workspace. 

This paper reports on a method for instantaneously minimizing torque loading at 
the joints in a least squares sense, by specification of a null space vector applied to 
generalized inverse accelerations and derived from manipulator dynamics. This method 
is compared to use of a straightforward pseudoinverse and to use of an inertia-weighted 
pseudoinverse with regard to the effect on joint torques. Portions of this research have 
been previously reported (Baillieul, HoUerbach, and Brockett, 1984; Hollerbach and 
Suh, 1985). 

2 The Generalized Inverse and Torque Optimization 

Consider an n degree of freedom manipulator whose task is described by m hand 
variables x, where m < n. Assume that the upper and the lower torque limits of the 
joints are r^ and t~ respectively, where for simplicity the limits are assumed motion 
independent. Then given a desired hand trajectory x{t), we would Uke to find the set 



of joint torques that results in x{t) and at the same time reduces actuator demands. 
One way of reducing the actuator demands is to place the joint torques closest to the 
midpoint of the joint torque limits |(t+ + t~). In the following, a method is presented 
for finding this set of joint torques using the null space of the Jacobian matrix. 

In order to incorporate dynamics, the redundancy is resolved at the acceleration 
level rather than at the velocity level. Using the pseudoinverse, the inverse kinematics 
readily follows from (18). 



^ = jt(x- J^) + (I-jtj)^ 



(26) 



where the null space vector (I - Jl J)^ now appears relative to (19). Substituting (26) 
into (20), 

r = r + H(I - jt J)^ (27) 

where 

r = Hjt(x- j^) + ^.C-^ + ^. (28) 

The goal is to place r closest to |(t+ + t~) in a least squares sense, that is to say, to 

T+ + T- ' 
T =^ 



mmimize 



Substituting (27) into (29) and defining 1^ = 1^-1 and t~ — r" 
as finding the vector ^ to minimize 



(29) 
r, the goal is recast 



H(I - JTJ),^ 



t TU - ^ +^ 



(30) 



This least squares problem can also be solved by the generalized inverse (Ben-Israel and 
Greville, 1980), yielding 

" H(I-jtj)l^-^'" + ^" 



<!> 



(31) 



This result can be extended to incorporate the idea that the available torque range is 
smaller for some joints than for others, through the use of weighted least squares (Ben- 
Israel and Greville, 1980). Given a weighting matrix W, we now want to minimize 



T+ +T- 
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(32) 



The solution to this is given by 
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W^H(I-jtj) 



it 



W^ii 
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T^ + T 



(33) 



where by definition W2W2 = W, Torque range can be incorporated into the least 
squares by a diagonal matrix W = diag{l/{T^ - r,")^). Weighting the least squares by 




Figure 1: Geometry of the three-link planar manipulator. 



the magnitude of the torque range seems a better procedure than the weighting schemes 
of Khatib and Yoshikawa, which are biased towards zero. 

3 Simulation 

The various algorithms for redundancy resolution at the acceleration level are demon- 
strated by simulation. 

1. The unweighted pseudoinverse algorithm derives the joint torques from (27) and 
(28). 

T = H3^x-3e) + e-C-d + g. (34) 



2. The inertia-weighted pseudoinverse algorithm is obtained from (21). 

r = HjtH(x -Jd) + e-c-e + g. 



(35) 



3. The unweighted null-space algorithm derives the joint torques from (27), (28), and 
(31). 

itf+ + r 



T = Hjt(x -3e) + 6-C-e + g-hIl H(I - jt J)l 
4. The weighted null-space algorithm is derived from (27), (28), and (33). 



(36) 



r = Hjt(x -JdJ + d-C-e + g + U 



W^H(I-jtj) 



it 



W^^ 



T^ -\- T 



(37) 



Methods 3 and 4 again make use of the identity B[CB]^ = [C-B]t, where B = (I- J''"J) 
is hermetian and idempotent (Maciejewski and Klein, 1985). 

The simulated manipulator is a planar rotary manipulator with three links (Fig- 
ure 1). The parameters of the arm are link lengths /^ = /j = /s = 1.0 and masses 



mi = m2 = ms = 10.0; link inertias are modeled by thin uniform rods. The simulated 
movements are straight-line Cartesian paths starting and ending with zero velocity, with 
constant tangential acceleration and deceleration of the magnitude \/2 over first and 
last half of the movement respectively. Total duration of the movement is varied to 
give the trajectories of different lengths. Tip orientation is not constrained, giving one 
degree of freedom redundancy. For simplicity gravity is ignored, and the upper and 
lower torque limits are set equal in magnitude yielding 1^ + 1' = 0. Torque limits for 
joints 1-3 are set at 54, 24, and 6 respectively, derived from ratios of mass moments 
at each joint when the arm is perfectly straight to ensure appropriate relative scaling. 
For the weighted null-space algorithm, the diagonal elements of the weighting matrix 
W were set as the inverse squares of these torque limits. 

The pseudoinverse was found using the singular value decomposition of a matrix 
(Strang, 1980), via a routine taken from Linpak User's Guide (Dongarra, 1979). After 
the joint torques were found, a fourth-order Runge-Kutta algorithm was used to find the 
next joint velocities and angles with an integration time interval of 1 msec. Programs 
were written in Fortran 77 in single precision and ran on the VAX 11/750 computer 
running 4.2 BSD UNIX. 

4 Results 

Performance of the unweighted null-space and pseudoinverse algorithms are com- 
pared in Figs. 2-4 for representative trajectories. For the short movement of Fig. 2, 
the null-space algorithm seems to give a substantial reduction in required joint torques. 
The most dramatic decrease is in the joint 1 torque, which is much smaller than for 
the unweighted pseudoinverse algorithm. While the other joint torques in the present 
example are decreased less, the joint 3 torque is pulled away from the perilously close 
torque limit of 6. For the intermediate length movement of Fig. 3, which is 2.5 times as 
long as in Fig. 2, the unweighted null-space algorithm still outperforms the unweighted 
pseudoinverse algorithm, although near the movement midrange and end the joint 2 
torques are somewhat larger though still within the torque range. 

For the long movement of Fig. 4, which is four times as long as in Fig. 2, the 
unweighted null space algorithm unexpectedly encounters stability problems near the 
movement end. The torques required to keep the manipulator endpoint on the planned 
trajectory become extremely high, occasioned by the joint alignment of links 2 and 3 
coupled with large velocities and accelerations in all the joints (Fig. 5). Evidently 
the unweighted null-space algorithm needs a long enough path for this situation to 
develop. Indeed, nearly any long path led to similar instability problems, since joint 
alignment and high velocities inevitably followed. This rarely happened in the case of 
the unweighted pseudoinverse algorithm. Although the unweighted null-space algorithm 
instantaneously gives smaller torques than the unweighted pseudoinverse algorithm, 
globally the unweighted null-space algorithm degrades unacceptably in performance 
with longer trajectories. 

Ordinarily one would expect a proximal joint such as joint 1 to have a larger actuator 
and a wider torque range than the distal joints, since it is required to exert more torque. 
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Figure 2: Torque profiles for a short movement for the pseudoinverse and null-space 
algorithms. 
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Figure 3: Medium-length movement. 
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Figure 4: Long movement showing instability. 

Yet in the unweighted torque optimization all joints are treated equal; the sum of squares 
of joint torques is minimized by reducing the largest torque which is the joint 1 torque 
by generating high accelerations at all the joints. If the torque optimization is done 
relative to the allowable torque range at each joint, the instability problem may be 
overcome. 

To test this idea, performance of the weighted null-space algorithm is examined for 
the same trajectory as in Fig. 2. It can be seen that the joint 3 torque is now much 
smaller at the expense of more torque at joints 1 and 2, but all remain well within their 
torque ranges (Fig. 6). Unfortunately, the weighted null-space algorithm also yields 
stability problems for the long movement of Fig. 4, so that the hoped-for elimination of 
instability with weights is not realized. There were even movements where the instability 
was shown only by the weighted case, although the reverse was not found. The observed 
characteristics of the instability in the weighted cases were identical to those of the non- 
weighted cases. 

Performance of the inertia-weighted pseudoinverse algorithm is also shown in Fig. 
6. Here and elsewhere the joint torques fell somewhere in between the unweighted 
pseudoinverse algorithm and the unweighted null-space algorithm. The inertia-weighted 
pseudoinverse algorithm also suffered from instabilities in longer movements. In most 
of the trajectories studied, whenever the null-space algorithm was unstable, the inertia- 
weighted pseudoinverse algorithm was unstable as well. 

5 Discussion 

The goal of this paper was to develop a local algorithm for reducing actuator require- 
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Figure 5: Velocity and acceleration profile for the movement in Figure 4. 
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Figure 6: Torque profiles for the short movement for the weighted null-space and iner- 
tia-weighted pseudoinverse algorithms. 
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Figure 7: A free-swinging pendulum acting under the influence of gravity directed along 
the former straight-line motion 

ments and avoiding torque limits, and the methods examined include use of a null-space 
acceleration vector, this vector weighted by torque range, and an inertia-weighted pseu- 
doinverse. These kinetic methods all lead to stability problems, even though locally 
these methods reduce actuator torques. Globally only the unweighted pseudoinverse al- 
gorithm, which by contrast is a kinematic method, is generally well-behaved, although 
on rare occasions it too shows instabilities. 

It seems that local tampering with the energetics of movement has led to global 
disaster. The torque profiles in Fig. 4 are representative of the problem. High acceler- 
ations in the distal joints lead to high joint velocities, and at the point where the third 
joint is straight these high velocities induce a whipping action that strongly thrusts 
the endpoint off the path. Substantial torques are required to overcome these natural 
movement dynamics and to maintain the planned endpoint trajectory. 

Insofar as torque optimization tends to reduce the torques towards zero, the situation 
may be analogous to a free-swinging pendulum. In Fig. 7 the manipulator has been 
started at the same position as the previous plots, but with gravity now acting along 
the original straight-line motion with a magnitude that yields an initial acceleration 
equal to the acceleration step in the simulated trajectories. The manipulator is allowed 
to fall freely under the influence of this gravity. The free-swinging pendulum exhibits a 
similar whipping action when the third joint straightens out. Thus the kinetic methods 
do indeed lead to utilization of the natural movement dynamics, but ultimately to 
the detriment of the movement goals with which the natural movement dynamics are 
incompatible. 

Whether the kinetic methods may be modified to avoid the instabilities is a subject 
of continuing research. One possibility is to weight the local optimization criterion with 
a kinematic term to avoid high velocity buildup. For staying within torque bounds. 
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linear programming rather than least squares may be more satisfactory. The broader 
question is whether any local algorithm can ever be completely successful, or whether 
ultimately only a global resolution of redundancy can be guaranteed problem-free. 
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